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(5) Verfahren zum Bestimmen relevanter Punkte eines Werkzeugs am Handflansch eines gesteuerten 
mehrachsigen Manipulators 

® Die Erfindung betrifft ein Verfahren zum Bestimmen 
relevanter Punkte eines Werkzeuges (4) am Handflansch 
eines gesteuerten mehrachsigen Manipulators (1). Die rele- 
vanten Punkte (5, 6, 7) warden im manipulatoreigenen 
World-Koordinaten-System bestimmt. Hierzu fahrt der Ma- 
nipulator (1) mit dam gesuchten relevanten Punkt (5, 6, 7) 
einen externen Referenzpunkt (10) mit bekannten Ortskoor- 
dinaten im World-Koordinaten-System (8) an. Dort wird 
anhand des Referenzpunktes (10) die Lage und Orientierung 
des Flansch-Koordinaten-Systems (9) des Manipulators (1) 
gegenuber dem World-Koordinaten-System (8) in der Mani- 
pulator-Steuerung (15) berechnet. Durch Koordinatentrans- 
formation sind anschlieSend Lage und Orientierung des 
. gesuchten relevanten Punktes (5, 6, 7) im Flansch-Koordiha- 

C ten -System (9) errechenbar. Hierzu wird der Referenzpunkt 
(10) in mindestens drei gewahlte representative Punkte (16. 
17, 18, 19) des Flansch-Koordinaten-Systems (9) tief verlegt 
[ Hierbei werden die Ortskoordinaten der reprasentativen 
[ Punkte (16, 17, 18, 19) im World-Koordinaten-System (8) 
aufgenommen und daraus die Lage und Orientierung des 
Flansch-Koordinaten-Systems (9) gegenuber dem World- 
Koordinaten-System (8) berechnet. 
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Die Erfindung betrifft ein Verfahren mit den Merk- 
malen im Oberbegriff des Hauptanspruches. 

In der Praxis besteht ein groBes Problem mit dem 
Austausch und der Vermessung neuer manipulatorge- 
fuhrter Werkzeuge. Damit die Manipulatorsteuerung 
ein Werkzeug exakt bewegen und positionieren kann, 
muB sie wissen, wo sich die relevanten Werkzeugpunk- 
te, insbesondere der sogenannte Tool-Center-Point, be- 
finden. Hierzu mussen standig die Ortskoordinaten die- 
ser relevanten Punkte im manipulatoreigenen World- 
Koordinaten-System bekannt sein. Die Koordinatenbe- 
schreibung erfolgt durch zwei Beziehungen, namlich 
einmal die relative Lage und Orientierung des relevan- 
ten Punktes innerhalb des Flansch-Koordinaten-Sy- 
stems der Manipulatorhand und zum anderen durch die 
Lage und Orientierung dieses Systems gegenuber dem 
World-Koordinaten-System. Beim Wechsel eines Werk- 
zeugs andern sich die relative Lage und Orientierung 
der relevanten Punkte gegenuber dem Flansch-Koordi- 
naten-System. In der Praxis war es daher bislang not- 
wendig, jedes Werkstuck exakt vor dem Gebrauch zu 
vermessen und dann lagegenau am Handflansch zu be- 
festigen. Durch diese? externe und sehr aufwendige 
Werkzeugvermessung konnten dann die Relativwerte 
fur Lage und Orientierung im Flansch-Koordinaten-Sy- 
stem von Hand ermitteit und in die Manipulatorsteue- 
rung eingegeben werden. Ein Werkzeugwechsel be- 
dmgte demnach einen erhebiichen Aufwand und erit- 
sprechende Kosten. 

Es ist daher Aufgabe der vorliegenden Erfindung, ein 
emfacheres, praktischeres und kostengunstigeres Ver^ 
fahren zum Bestimmen der relevanten Punkte eines 
Werkzeugs aufzuzeigen. 

Die Erfindung lost diese Aufgabe mit den Merkmalen 
im Hauptanspruch. 

Mit der Erfindung ist keine externe Werkzeugver- 
messung mehr notwendig. VieJmehr findet die Bestim- 
mung der relevanten Punkte am Manipulator mit dem 
angebauten Werkzeug statt und geht auch mit sehr viel 
weniger Bau-, Zeit- und Kostenaufwand vor sich. 

Es genugt, den gesuchten relevanten Punkt des Werk- 
zeugs an einen externen, d. h. im Arbeitsraum des Mani- 
pulators liegenden Referenzpunkt mit bekannten Orts- 
koordinaten im World-Koordinaten-System zu verfah- 
ren. An dieser Stelle hat der gesuchte relevante Punkt 
bekannte absolute Ortskoordinaten, namlich die des Re- 
ferenzpunktes. Hieraus laBt sich zum einen die bis dahin 
unbekannte relative Lage und Orientierung des 
Flansch-Koordinaten-Systems gegenuber dem World- 
Koordinaten-System ermitteln. Aus . zwei bekannten 
Koordinatensystemen konnen wiederum die Ortskoor- 
dmaten^des Referenzpunktes bzw. des dort befindlichen 
relevanten Werkzeugpunktes in das Flansch-Koordina- 
ten-System transformiert werden. Aus diesen beiden re- 
lativen Ortskoordinaten laBt sich wiederum die Lage 
und Orientierung des relevanten Punktes gegenuber 
dem Flansch-Koordinaten-System berechnen. In der 
Regel geht es hierbei urn den Abstand (T), den Seiten- 
versatz (L) und den Drehwinkel (D) urn die z-Achse des 
relevanten Punktes gegenuber dem Handflansch. 

Das Verfahren kann vereinfacht werden, wenn in der 
Bahnensteuerung schon die Lage und Orientierung des 
Flansch-Koordinaten-Systems gegenuber dem World- 
Koordmaten-System bekannt und abrufbar ist. Der Er- 
mittiungsschritt der Relativbeziehung zwischen den bei- 
den Korrdinatensystemen kann dann entfallen. Bei den 



momentanen Steuerungen ist dies zwar grundsatzlich 
moglich, aber noch nicht in der Praxis realisiert. 

Das erfindungsgemaBe Verfahren eignet sich fur be- 
liebige Werkzeuge und auch fur beliebige relevante 
5 Punkte. Es ist fur mehrachsige Manipulatoren und ins- 
besondere fur mehrachsige Industrieroboter geeignet. 
Es dient nicht nur zur Vermessung neuer Werkzeuge, 
sondern kann auch zur Kontrolle benutzter Werkzeuge 
auf eventuelle Schaden verwendet werden. 
i o Fur die Bestimmung des Referenzpunktes gibt es ver- 
schiedene Moglichkeiten. Im einfachsten Fall ist der Re- 
ferenzpunkt irgendwo im Arbeitsraum des Manipula- 
tors, eventuell sogar am Manipulator selbst, positioniert 
und bereits vorab vermessen. Urn die Vermessung zu 
15 vereinfachen, kann hierfiir auch der Manipulator mit 
einem bereits bekannten Werkzeug eingesetzt werden. 
Dessen ebenfalls bekannter relevanter Punkt, beispiels- 
weise der Tool-Center-Point, wird auf den Referenz- 
punkt gefahren, wobei die mitgefuhrten absoluten Orts- 
20 koordinaten des relevanten Punktes aufgenommen und 
dann dem Referenzpunkt in der Steuerung zugeordnet 
werden. In der Praxis laBt sich dies auf einfache Weise 
mit emem Dorn realisieren, dessen Spitze den Referenz- 
punkt markiert. 
25 Urn einen hoheren FComfort und insbesondere auch 
eine Mdglichkeit zur Automatisierung des Bestim- 
mungsvorganges zu erreichen, wird der gesuchte rele- 
vante Punkt selbst als Referenzpunkt herangezogen 
Dies ist mit Hilfe eines auf das World-Koordinaten-Sy- 
30 stem referierten Vermessungssystems moglich, das den 
gesuchten relativen Punkt erfaBt und dessen Ortskoor- 
dinaten bestimmt. Vorteilhafterweise muB dazu nicht 
unbedingt ein bestimmter Punkt im Arbeitsraum ange- 
fahren werden, sondern es genugt irgendeine frei wahi- 
35 bare Stelle im Erfassungsraum des Vermessungssy- 
stems. Dadurch kann der Manipulator den Bestim- 
mungsvorgang selbsttatig und automatisch durchfuh- 
ren, da er keinen bestimmten Referenzpunkt mehr an- 
steuern muB. 

40 Das Vermessungssystem kann in unterschiedlicher 
Weise realisiert werden, beispielsweise als Laser- Re- 
flex-System, Radar oder auf sonstige Art. Bevorzugt 
wird die optische Messung mit einem Kamerasystem, 
das besonders exakte Positionswerte des relevanten 
45 Punktes im Raum liefert und zuverlassig arbeitet. Ein 
solches Kamerasystem ist im ubrigen auch fur andere 
Zwecke bei Industrierobotern ohnehin haufig schon im 
Einsatz. 

In weiterer Alternative kann auch ein unbekannter 
50 mechanischer Referenzpunkt, beispielsweise ein Dorn, 
mit einem ebenfalls unbekannten Werkzeug viermal aus 
verschiedenen Richtungen angefahren werden. In alien 
vier Positionen werden von der Manipulatorsteuerung 
die gemeldeten Ortskoordinaten im World-Koordina- 
55 ten-System aufgenommen und miteinander verglichen. 
Nachdem sich das Werkzeug nicht andert und immer 
mit dem gleichen relevanten Punkt den Referenzpunkt 
beruhrt, mussen die aufgenommenen vier Punkte auf 
einer Kugel urn den Referenzpunkt liegen, deren Mittei- 
60 punkt und damit der Referenzpunkt sich dann ohne wei- 
teres errechnen laBt. 

Die Erfindung ist in den Zeichnungen beispielsweise 
und schematisch dargestellt Im einzelnen zeigen 
Fig. 1 in perspektivischer Ansicht und schematischer 
65 Darstellung einen Industrieroboter mit einem zu ver- 
messenden Werkzeug und 

Fig. 2 eine vergroBerte Darstellung des Handflan- 
sches und seines Koordinatensystems. 
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Der in Fig. 1 gezeigte sechs-achsige Industrieroboter 
(!) besitzt eine mehrfach abwinkelbare Hand (2) in 
Form einer sogenannten Zentralhand, die am vorderen 
Ende einen Handflansch (3) tragt Am Handflansch (3) 
ist ein Werkzeug (4) befestigt, das im gezeigten Ausfuh- 
rungsbeispiel mehrfach abgewinkelt ist und drei rele- 
vante Punkte (5, 6, 7) tragt Der relevante Punkt (5) an 
der Werkzeugspitze ist der sogenannte Tool-Center- 
Point, auf den die Manipulatorsteuerung (15) die Robo- 
terbewegungen abstimmt Der Tool-Center- Point ist 
beispielsweise bei einem SchweiBbrenner die Spitze des 
aus der Diise tretenden SchweiBdrahtes. Der zweite re- 
levante Punkt (6) ist beispielsweise ein vorstehender 
Ansatz, der Kollisionsprobleme aufwerfen kann und da- 
her in der Manipulatorsteuerung (15) bei den Werk- 
zeugbewegungen berucksichtigt werden muB. Ahnli- 
ches gilt fur den dritten relevanten Punkt (7), der bei- 
spielsweise ein Knickpunkt ist Die relevanten Punkte 
(6, 7) konnen auch Achsen eines in sich beweglichen 
Werkzeugs sein. In Abwandlung des gezeigten Ausfuh- 
rungsbeispiels kann ein Werkzeug (4) auch nur einen 
relevanten Punkt oder eine beliebige groBere Zahl sol- 
dier Punkte haben. 

Die Positibnswerte des Werkzeugs (4) und die Robo- 
terbewegungen sirid auf ein manipulatoreigenes World- 
Koordinaten-System (8) bezogen, das vorzugsweise 
kartesisch ist. Der Handflansch (3) besitzt ein eigenes 
Flansch-Koordinaten-System (9), das ebenfalls vorzugs- 
weise kartesisch ist Der Ursprung des Flansch-Koordi- 
naten-Systems (9) ist zugleich der Flanschmittelpunkt 

Die relevanten Punkte (5, 6, 7) des Werkzeugs (4) 
stehen in einer bestimmten Lage und Orientierung zum 
Flansch-Koordinaten-System (9). Im gezeigten Ausfuh- 
rungsbeispiel wird diese Beziehung durch den Abstand 
(T) entlang der z-Achse, den Seitenversatz (L) entlang 
der x-Achse und den Drehwinkel (D) um die z-Achse 
definiert. Mit diesen drei Werten ist die relative Lage 
und Orientierung des betrachteten relativen Punktes (5, 
6, 7) gegenuber dem Flansch-Koordinaten-System (9) 
festgelegt. 

Die relative Lage und Orientierung des Flansch-Ko- 
ordinaten-Systems (9) gegenuber dem World-Koordi- 
naten-System ist in der Manipulatorsteuerung (15) zwar 
bekannt, aber nicht in Parameterform durch Anzeige 
abrufbar. In der Manipulatorsteuerung (15) liegen je- 
doch bei einem bekahnten Werkzeug die Ortskoordina- 
ten der relevanten Punkte (5, 6, 7) im World-Koordina- 
ten-System abrufbar und anzeigbar vor. Sie setzen sich 
durch Koordinatentransformation aus der Relativbezie- 
hung zwischen den relevanten Punkten und dem 
Flansch-Koordinaten-System und dessen Relativbezie- 
hung gegenuber dem World- Koordinateii-System zu- 
sammen. 

Bei einem Werkzeugwechsel oder einer Kollision des 
Werkzeugs (4) mit einem Hindernis ist die Lage und 
Orientierung eines oder mehrerer der relevanten Punk- 
te (5, 6, 7) gegenuber dem Flansch-Koordinaten-System 

(9) nicht oder nicht mehr bekannt und muB neu be- 
stimmt werden. Dieser Bestimmungsvorgang lauft wie 
folgtab: 

Das unbekannte oder beschadigte Werkzeug (4) wird 
mit dem zu bestimmenden relevanten Punkt (5, 6, 7) vom 
Roboter (1) im Arbeitsraum auf einen Referenzpunkt 

(10) gefahren. Im gezeigten Ausfuhrungsbeispiel besteht 
dieser aus der Spitze eines ortsfesten Kegels (11), die 
beim Anfahren punktgenau beruhrt wird. Die Ortskoor- 
dinaten des Referenzpunktes (10) liegen im World-Ko- 
ordinaten-System (8) vor und sind entweder vorher be- 
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stimmt worden oder werden wahrend des Anfahrens 
durch den relevanten Punkt (5, 6, 7) bestimmt Die ver- 
schiedenen Alternativen werden nachfolgend naher er- 
lautert. Fur die weitere Erklarung des Verfahrens zur 
5 Bestimmung der gesuchten relativen Punkte (5, 6, 7) 
werden die absoluten Ortskoordinaten des Referenz- 
punktes (10) im World-Koordinaten-System (8) als be- 
kannt angenommen. 

Wenn sich der gesuchte relevante Punkt (5, 6, 7) am 

io Referenzpunkt (10) befindet, werden in der Bahnen- 
steuerung die bekannteh Ortskoordinaten dem relevan- 
ten Punkt (5, 6, 7) zugeordnet FQr die nachfolgende 
Bestimmungsoperation bleiben der Manipulator (1) mit 
dem Werkzeug (4) und dem zu bestimmenden relevan- 

15 ten Punkt (5,6,7) ortsfest stehen. 

Wenn die relative Lage des Flansch-Koordinaten Sy- 
stems gegenuber dem World-Koordinaten-System (8) 
nicht abrufbar ist, wird sie durch den nachfolgenden 
Verfahrensabschnitt ermittelt Wie eingangs erwahnt 

20 setzt sich der Ortsvektor vom Koordinatenursprung 
bzw. dem Flanschmittelpunkt zum betrachteten rele- 
vanten Punkt (5, 6, 7) aus den achsbezogenen Abstanden 
(T) und (L) zusammen. Zur Bestimmung der Lage und 
Orientierung des Flansch-Koordinaten-System (9) ge- 

25 geniiber dem World-Koordinaten-System (8) wird der 
Referenzpunkt (10) bzw. der betrachtete relevante 
Punkt (5, 6, 7) auf mindestens drei, vorzugsweise vier 
gewahlte Punkte (16, 17, 18, 19) verlegt und sozusagen 
abgebildet Die Punkte (16, 17, 18, 19) sind reprasentativ 

30 fur das Flansch-Koordinaten-System und liegen auf des- 
sen verschiedenen Achsen. Bei der Verlegung wird der 
betrachtete relevante Punkt (5, 6, 7) fiktiv auf dem 
Flansch-Koordinaten-System (9) abgebildet und sozusa- 
gen umdefiniert. Es werden hierdurch drei oder vier 

35 neue Ortskoordinaten der reprasentativen Punkte (16, 
17, 18, 19) im World-Koordinaten-System (8) gewonnen. 

In der gezeigten Ausfuhrungsfdrm wird der Tool- 
Center- Point (5) betrachtet Wie Fig. 2 zeigt, werden bei 
einem Drehwinkel (D) — 0 (T) und (L) ebenfalls als 0 

40 definiert Der Tool-Center- Point (5) kommt damit fiktiv 
auf dem Koordinatenursprung des Flansch-Koordina- 
ten-Systems (9) zu liegen, wobei in der Manipulator- 
steuerung (15) entsprechende Ortskoordinaten fur die- 
sen reprasentativen Punkt (16) im World-Koordinaten- 

45 System (8) ausgegeben und gegebenenfalls gespeichert 
werden. Durch Definition von (D) und (L) = 0 wird der 
Tool-Center- Point (5) auf dem reprasentativen Punkt 
(17) der L-Achse abgebildet, der vom Koordinatenur- 
sprung den Abstand (T) hat Desweiteren wird durch (D) 

50 und (T) — 0 der Tool-Center- Point (5) auf dem dritten 
reprasentativen Punkt (18) der x-Achse abgebildet, der 
vom Koordinatenursprung den Abstand (L) hat. Gege- 
benenfalls kann auf der y-Achse aus den reprasentati- 
ven Punkten (16. 17, 18) ein vierter reprasentativer 

55 Punkt (19) unter Vorgabe von (D) = 0 errechnet wer- 
den. Durch die reprasentativen Punkte (16, 17, 18, 19) 
und deren Ortskoordinaten im World-Koordinaten-Sy- 
stem (8) ist das Flansch-Koordinaten-System (9).eindeu- 
tig in der Translation und Rotation gegenuber dem 

60 World-Koordinaten-System (8) bestimmt 

Durch die Relativbeziehung zwischen den beiden Ko- 
ordinatensystemen (8, 9) kdnnen nun auch Ortskoordi- 
naten beliebiger Punkte vom einen in das andere Koor- 
dinatensystem (8, 9) transformiert werden. Durch Koor- 

65 dinatentransformation werden nun die Ortskoordinaten 
des Tool-Center- Points (5) im Flansch-Koordinaten-Sy- 
stem (9) errechnet. Aus diesem Ortsvektor wiederum 
werden (T), (L) und (D) fur den Tool-Center-Point des 
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neuen oder beschadigten Werkzeugs errechnet und als 
Parameter in der Manipulatorsteuerung (15) gespei- 
chert. Die Bestimmung des Tool-Center- Points (5) ist 
damit abgeschlossen. Die weiteren relevanten Punkte 
(6, 7) konnen auf die gleiche vorbeschriebene Weise 
bestimmt werden. 

Die Durchfiihrung der Rechenoperationen kann an- 
hand der von der Manipulatorsteuerung (15) angezeig- 
ten Ortskoordinaten von Hand durchgefuhrt werden. In 
der bevorzugten Ausfuhrungsform hat die Manipulator- 
steuerung (15) ein integriertes Rechen- oder Software- 
modul, das die Operationen automatisch und intern 
durchfuhrt. Fur die Bestimmung der weiteren relevan- 
ten Punkte (6, 7) konnen damit auch die bereits aufge- 
fundenen reprasentativen Punkte (16, 17, 18, 19) bzw. 
das Flansch-Koordinaten-System (9) beim Anfahren der 
nachsten relevanten Punkte (6, 7) mitgenommen wer- 
den, so daB Lage und Orientierung des Flansch-Koordi- 
naten-Systems (9) gegeniiber dem World-Koordinaten- 
System (8) auch an den weiteren Punkten sofort zur 
Verfugung stehen. 

Die Ermittlung der Ortskoordinaten des Referenz- 
punktes (10) im World-Koordinaten-System (8) ist auf 
verschiedehe Weise mfiglich. Zum einen kann der Robo- 
ter (1) ein bekanntes Werkzeug (4) mit einem bekannten 
Tool-Center-Point (5) oder einem sonstigen relevanten 
Punkt auf den Referenzpunkt (10) bewegen. Die Mani- 
pulatorsteuerung (15) ubernimmt dann die im World- 
Koordinaten-System (8) mitgefuhrten und angezeigten 
Ortskoordinaten des bekannten Tool-Center- Points (5) 
und ordnet sie dem Referenzpunkt (10) zu. Anschlie- 
Bend wird das bekannte Werkzeug (4) gegen das unbe- 
kannte getauscht und dann das vorstehend beschriebe- 
ne Bestimmungsverfahren durchgeftthrt. 

Eine zweite Moglichkeit zur Bestimmung der Ortsko- 
ordinaten des Referenzpunktes (10) besteht darin, mit 
einem unbekannten Werkzeug (4) und einem demge- 
maB unbekannten relevanten Punkt (5, 6, 7) den eben- 
falls unbekannten Referenzpunkt (10) von Hand mit 
dem Manipulator anzufahren. Das Anfahren findet vier- • 
mal aus verschiedenen Richtungen und mit verschiede- 
nen Achsstellungen des Roboters (1) statt. Jedesmai 
werden dabei die in der Manipulatorsteuerung (15) an- 
gezeigten absoluten Ortskoordinaten in der eingangs 
beschriebenen Weise auf den Flanschmittelpunkt (16) 45 
durch Definition von (D, T, L) » 0 abgebildet. Die ange- 
gebenen Ortskoordinaten der vier Punkte sind zwar we- 
gen des noch nicht vermessenen Werkzeugs (4) als ein- 
zelne Absolutwerte unrichtig. Zusammen definieren sie 
aber vier Punkte einer Kugel deren Mittelpunkt der 50 
Referenzpunkt (10) ist. Aus den Ortskoordinaten kann 
uber die Kugelbeziehung dann ein korrekter Positions- 
wert fiir den Referenzpunkt (10) im Worldkoordinaten- 
system (8) errechnet werden. Beim vierten Anfahren 
wird auBerdem in der eingangs beschriebenen Weise 55 
durch Abbildung des nun korrekten Referenzpunktes 
(10) auf drei oder vier representative Punkte (16, 17, 18, 
19) das Flanschkoordinatensystem (9) bestimmt Der 
weitere Bestimmungsvorgang fur den gesuchten rele- 
vanten Punkt (5, 6, 7) findet ebenfalls in der vorgeschrie- 6 o 
benen Weise statt. 

Eine dritte Moglichkeit besteht im Einsatz eines Ver- 
messungssystems (12), das den gesuchten relevanten 
Punkt (5, 6, 7) erfaflt und seine Position in Ortskoordina- 
ten des Worldkoordinatensystems (8) angibt. Im gezeig- 65 
ten Ausfiihrungsbeispiel besteht das Vermessungssy- 
stem (12) aus zwei Kameras (13), die einen internen 
Raster zur Bewegungsund Positionsverfolgung beinhal- 
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ten und eine Auswerteschaltung (14) aufweisen. Das 
Vermessungssystem (12) hat ein eigenes Koordinaten- 
system, das bei der Einrichtung uber eine Koordinaten- 
transformation auf das Worldkoordinatensystem (8) re- 
5 feriert wird. Die Einrichtung kann mit Hilfe eines be- 
kannten Werkzeuges (4) und dessen Tool-Center-Point 
(5) mit bekannten Ortskoordinaten erfolgen. Urn den 
Tool-Center- Point (5) der verschiedenen Werkzeuge (4) 
oder einen sonstigen relevanten Punkt (6, 7) zuverlassig 
10 erfassen zu konnen, ist an diesen Stellen eine LED ange- 
ordnet. Zur Bestimmung eines relevanten Punktes (5, 6, 
7) eines unbekannten oder beschadigten Werkzeugs (4) 
wird dieser Punkt vom Roboter (1) an irgendeine Stelle 
im Erfassungsraum des Vermessungssystems (12) be- 
15 wegt Im Gegensatz zu den vorgenannten Positionier- 
verfahren kann dies auch automatisch und Qber die Ma- 
nipulatorsteuerung (15) geschehen: Die eingenommene 
Stellung des relevanten Punktes (5, 6, 7) ist zugleich der 
Referenzpunkt (10) dessen Ortskoordinaten vom Ver- 
20 messunssystem (12) aufgenommen und im Worldkoordi- 
natensystem (8) angezeigt werden und in die Manipula- 
torsteuerung (15) eingegeben werden. Der weitere Be- 
stimmungsvorgang lauft in der eingangs beschriebenen 
Weise ab. 

25 

Stiickliste 

1 Manipulator, Industrieroboter 

2 Hand 

3 Handflansch 

4 Werkzeug 

5 relevanter Punkt, Tool-Center-Point 

6 relevanter Punkt, Ansatz 

7 relevanter Punkt, Knickpunkt 

8 World-Koordinaten-System 

9 Flansch-Koordinaten-System 

10 Referenzpunkt 

1 1 Dorn 

12 Vermessungssystem, Kamerasystem 

13 Kamera 

14 Auswerteschaltung 

15 Manipulatorsteuerung 

16 reprasentativer Punkt, Ursprung, 
Flanschmittelpunkt 

17 reprasentativer Punkt, z-Achse 

18 reprasentativer Punkt, x-Achse 

19 reprasentativer Punkt, y-Achse 

Patentanspriiche 

1. Verfahren zum Bestimmen relevanter Punkte ei- 
nes Werkzeugs am Handflansch eines gesteuerten 
mehrachsigen Manipulators im manipulatoreige- 
nen World-Koordinaten-System, wobei der rele- 
vante Punkt in der Manipulatorsteuerung durch 
seine relative Lage und Orientierung innerhalb des 
Flansch-Koordinaten-Systems und dessen Lage 
und Orientierung gegenuber dem World-Koordi- 
naten-System beschriebeh wird, dadurch gekenn- 
zeichnet, daQ der Manipulator (1) mit dem relevan- 
ten Punkt (5, 6, 7) des Werkzeugs (5) einen externen 
Referenzpunkt (10) mit bekannten Ortskoordina- 
ten im World-Koordinaten-System (8) anfahrt, wo- 
nach dort anhand des Referenzpunktes (10) die La- 
ge und Orientierung des Flansch-Koordinaten-Sy- 
stems (9) gegenuber dem World-Koordinaten-Sy- 
stem (8) in der Manipulatorsteuerung (15) berech- 
net wird, und daB dann durch Koordinatentransfor- 
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mation die Lage und Orientierung des relevanten 
Punktes (5, 6, 7) im Flansch-Koordinaten-System (9) 
berechnet wird. 

2. Verfahren nach Anspruch 1, dadurch gekenn- 
zeichnet, daB zur Bestimmung von Lage und Orien- 5 
tierung des Flansch-Koordinaten-Systems (9) der 
Referenzpunkt (10) in mindestens drei gewahlte re- 
presentative Punkte(16, 17, 18, 19) des Flansch-Ko- 
ordinaten-Systems (9) fiktiv verlegt wird, wobei die 
Ortskoordinaten der reprasentativen Punkte (16, 10 
17, 18, 19) im World-Koordinaten-System (8) aufge- 
nommen werden, und daB daraus die Lage und 
Orientierung des Flansch-Koordinaten-Systems (9) 
gegenuber dem World-Koordinaten-System (8) be- 
rechnet werden. 15 

3. Verfahren nach Anspruch 2, dadurch gekenn- 
zeichnet, daB die reprasentativen Punkte (16, 17, 18, 
19) auf den Ursprung und mindestens zwei Achsen 
des Flansch-Koordinaten-Systems (9) verlegt wer- 
den. 20 

4. Verfahren nach Anspruch 1 oder einem der fol- 
genden, dadurch gekennzeichnet, daB Lage und 
Orientierung des relevanten Punktes (5, 6, 7) im 
Flansch-Koordinaten-System (9) durch Hohenab- 
stand (T), Seitenversatz (L) und Drehwinkel (D) urn 25 
die z-Achse bestinimt werden. 

5. Verfahren nach Anspruch 1 oder einem der fol- 
genden, dadurch gekennzeichnet, daB die Ortsko- 
ordinaten des Referenzpunktes (10) durch vorheri- 
ges Anfahren mit einem bekannten Werkzeug be- 30 
stimmt werden. 

6. Verfahren nach einem oder mehreren der An- 
spruche 1 bis 4, dadurch gekennzeichnet, daB der 
relevante Punkt (5, 6, 7) des Werkzeugs (4) an einen 
wahlbaren Referenzpunkt (10) im Erfassungsbe- 35 
reich eines auf das World-Koordinaten-System (8) 
referierten Vermessungssystems (12) gefahren 
wird, wo seine Ortskoordinaten bestimmt werden. 

7. Verfahren nach Anspruch 6, dadurch gekenn- 
zeichnet, daB der relevante Punkt (5, 6, 7) optisch 40 
erfaBt und vermessen wird. 

8. Verfahren nach Anspruch 1 oder einem der fol- 
genden, dadurch gekennzeichnet, dafl die Rechen- 
operationen in der Manipulatorsteuerung (15) 
durchgefuhrt werden. 45 
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